Research on dynamic window algorithm of mine mobile robot based on membrane computing and particle swarm optimizatio
-
摘要: 针对煤矿移动机器人采用传统动态窗口算法在复杂环境中规划路径时存在路径规划不合理、规划速度慢和实时性较差等问题,提出了一种基于膜计算和粒子群的煤矿移动机器人动态窗口算法。利用粒子群中的随机性和膜计算的分布式并行计算能力对传统动态窗口算法进行优化,将动态窗口算法中的煤矿移动机器人速度限制空间转换为坐标空间,将煤矿移动机器人的速度坐标看作粒子位置,将速度采样方式从均匀等分采样变为随机采样,并将采样粒子均匀分配到各基本膜中,利用膜间交流和膜内粒子更新机制对粒子进行评价和更新,不断迭代输出最优速度,煤矿移动机器人根据连续时间段间隔内输出的最优速度进行路径规划。仿真结果表明,该算法通过基于膜计算和粒子群算法对煤矿移动机器人的速度限制区域进行优化,提高了速度采样的随机性和规划路径的合理性;与传统动态窗口算法相比,该算法在降低规划步数和每步评价次数的同时,可缩短7%~10%的规划路径长度和9%~32%的规划时间,并可适应含U型障碍物的特殊环境。Abstract: In view of problems such as unreasonable path planning, slow planning speed and poor real -time performance when mine mobile robots use traditional dynamic window algorithm to plan path in complex environment, a dynamic window algorithm of mine mobile robot based on membrane computing and particle swarm optimization was proposed. The traditional dynamic window algorithm is optimized by using randomness of particle swarm optimization and distributed parallel computing ability of membrane computing. In the dynamic window algorithm, the velocity limit space of mine mobile robot is transformed into coordinate space, and the velocity coordinate of the mine mobile robot is regarded as particle position. The speed sampling mode is changed from uniform equal sampling to random sampling, the sample particles are evenly distributed to each basic membrane. The exchange between membranes and the renewal mechanism of particles in membrane are used to evaluate the renewal of particles. The optimal speed is output continuously. The path planning of the mine mobile robot is based on the optimal output speed in continuous time interval. The simulation results show that the algorithm optimizes the speed limit region of mine mobile robot by membrane computing and particle swarm optimization algorithm, and improves the randomness of speed sampling and the rationality of planning path. Compared with the traditional dynamic window algorithm, the proposed algorithm can not only reduce the number of planning steps and the evaluation times of each step, but also shorten the planning path length by 7% -10% and the planning time by 9% -32%, and can adapt to the special environment with U -shaped obstacles.
-
0. 引言
煤矿井下可能发生瓦斯爆炸、煤尘爆炸、水害、顶板事故、通道堵塞、有毒有害气体扩散等灾害[1]。传统的逃生路径规划多基于静态的矿井布局,无法有效应对事故发生后巷道变形、巷道底鼓、巷道坡度变化、水位变化、障碍物变化等动态变化[2]。因此,快速确定适应环境变化的逃生路径对于提高矿工在紧急情况下的逃生效率和生存概率至关重要。
在路径动态规划研究方面,黄昕等[3]组建了火灾场景关键指标的时程数据库,将人体耐受性指标限值作为判定依据,进行可逃生区域识别和火灾场景动态重构,采用A*算法识别逃生路径,完成疏散路径动态规划,但该方法给出的逃生路径比较复杂,不利于煤矿井下工作人员的应急逃生。曹祥红等[4]利用A*算法提升初始信息素浓度,通过改进启发函数和路径平滑处理实现路径规划,但规划的路径较长,不利于井下人员在有限时间内及时到达安全区域。于丹等[5]以路径最短为原则,构建了煤矿井下避灾路径规划模型,采用Dijkstra算法求解,确定最优路径规划方案,但Dijkstra算法依赖预先定义的静态网络和固定权重,无法适应井下环境的动态变化。朱军等[6]通过导航网格动态生成算法实现了室内火灾逃生路径动态规划,但对环境中障碍物的避障能力不佳,不利于煤矿井下工作人员的应急逃生。
为提升在煤矿井下复杂多变环境下的路径规划效果,本文提出一种基于Dijkstra−ACO(Ant Colony Optimization,蚁群优化)混合算法的煤矿井下应急逃生路径动态规划方法。根据煤矿井下巷道内实体关系,考虑巷道坡度和水位对逃生行动的影响,建立煤矿井下应急逃生最优路径动态规划模型。采用Dijkstra−ACO混合算法求解最优路径动态规划模型,即先利用Dijkstra算法的高效性迅速确定1条初始逃生路径,再通过ACO算法对初始路径进行优化,从而确保矿工在紧急情况下能够迅速找到安全、可靠的逃生路径。
1. 煤矿井下应急逃生路径动态规划
1.1 煤矿井下应急逃生最优路径动态规划模型
煤矿井下应急逃生路径动态规划主要涉及巷道、人员、设施等实体,将巷道中的每一段(即连接各个节点的线段)抽象为一个网络边,网络边权重反映逃生的难易程度,2条或多条巷道的交叉口实体抽象为网络节点。在路径规划过程中,算法优先选择权重小的网络边来确保逃生路径更安全、快捷。
网络边权重与应急逃生影响因素有关,如巷道内水位高度、巷道的长度和坡度等。巷道坡度直接关系到逃生者的行进速度和体力消耗,坡度较陡的巷道可能导致逃生速度减慢,增加体力负担,尤其是在紧急情况下,逃生者可能因体力不支而无法迅速撤离[7-9]。巷道内水位的高低直接影响到逃生路径的通行状况,高水位可能导致部分巷道被淹没,甚至完全阻断逃生通道,增加逃生难度和风险[10-12]。因此,重点考虑巷道坡度和巷道内水位对逃生的影响,并对其分配动态综合权重。
1) 巷道坡度。将巷道坡度转换为弧度制,利用反正弦函数将坡度转换为0到1之间的数值,并进行归一化处理,得到巷道坡度权重:
$$ {\omega _{{\mathrm{s}}_{ij}}} = {{\mathrm{arcsin}} }\left( {{c_i} - {c_j}} \right) $$ (1) 式中$ {c_i} $和$ {c_j} $分别为三维巷道网络拓扑中节点$ i $和节点$ j $对应的标高经归一化处理后的值。
2) 巷道内水位。巷道内水位权重为
$$ \omega_{\mathrm{h}}=\left\{\begin{array}{l}\dfrac{V}{WL}\; \; \; \; \sigma=0 \\ \sqrt{\dfrac{V\sin2\sigma}{W}}\; \; \; \; 0 < \sigma < 90^{\circ},0\leqslant V\leqslant\dfrac{WH^2}{2\tan\sigma} \\ H\cos\sigma+L\sin\sigma\; \; \; \; 0 < \sigma < 90^{\circ},\dfrac{WH^2}{2\tan\sigma} < V < WHL \\ \dfrac{V}{WH}\; \; \; \; \sigma=90^{\circ}\end{array}\right. $$ (2) 式中:$ V $为巷道积水总量;$ \sigma $为巷道坡度;$ W $和$ H $分别为巷道地面宽度和高度;$ L $为水体在巷道内的纵向距离。
3) 网络边动态综合权重。网络边权重是在某一特定时刻或相对稳定的煤矿环境下根据巷道固有属性确定的,然而由于煤矿井下环境可能随时发生变化,所以需要对网络边权重进行动态调整。
网络边动态综合权重为
$$ \omega_{ij}=A_{\mathrm{s}}\omega_{\mathrm{s}_{ij}}+A_{\mathrm{h}}\omega_{\mathrm{h}} $$ (3) 式中:$ {A_{\mathrm{s}}} $为巷道坡度的影响系数;$ {A_{\mathrm{h}}} $为巷道内水位的影响系数。
巷道坡度的影响系数表达式为
$$ {A_{\mathrm{s}}} = 1 + \alpha \left| {\sin \sigma } \right| $$ (4) 式中$ \alpha $为巷道坡度的权重系数。
巷道内水位的影响系数表达式为
$$ {A_{\mathrm{h}}} = 1 + \beta \frac{\omega _{\mathrm{h}}}{H} $$ (5) 式中$ \;\beta $为巷道内水位的权重系数。
建立煤矿井下应急逃生最优路径动态规划模型,用于在给定起点和终点的情况下,找到一条动态综合权重和最小的逃生路径,即逃生难度最低。该模型目标函数为
$$ \min\ \omega_{ij}=\min\sum\limits_{i=1}^{n-1}\sum\limits_{j=2}^n\left(A_{\mathrm{s}}\omega_{\mathrm{s}_{ij}}+l_{ij}+A_{\mathrm{h}}\omega_{\mathrm{h}}\right) $$ (6) 式中:$ n $为节点数量;$ {l_{ij}} $为三维巷道网络拓扑中节点$ i $到节点$ j $之间网络边长度经归一化处理后的值。
1.2 Dijkstra−ACO混合算法
Dijkstra算法是一种典型的单源最短路径算法,用于在加权图中找到从单一源点到其他所有节点的最短路径[13-14]。然而,Dijkstra算法主要基于局部信息(即当前节点到其邻接节点的距离)进行搜索,缺乏全局视野。ACO算法是一种基于群体的启发式搜索算法,通过模拟蚂蚁在寻找食物过程中的信息素更新机制,能够在全局范围内搜索最优解[15]。因此,结合Dijkstra算法的局部搜索能力和ACO算法的全局搜索能力,求解煤矿井下应急逃生最优路径动态规划模型,具体流程如下:
1) 引入Dijkstra算法确定初始路径,并对全部参数进行初始化。
2) 引入ACO算法展开路径搜索,选择节点位置。
3) 当蚂蚁经过任意1条路径时,局部更新蚂蚁经过路径上的信息素。
$$ {\tau _{ij}} = \left( {1 - \rho } \right){\tau _i} + \sum\limits_{a = 1}^m { \tau _{ij}^a} $$ (7) $$ \tau _{ij}^a = \frac{Q}{{{l_a}}} {S_{ a}} $$ (8) 式中:τij为蚂蚁经过节点i到节点j路径的信息素;ρ为信息素挥发率;τi为蚂蚁在节点i的信息素;$ m $为蚂蚁数量;$ \tau _{ij}^a $为第a只蚂蚁经过节点i到节点j路径上的信息素;$ Q $为信息素增强因子;$ {l_a} $为第a只蚂蚁走过的路径长度;$ {S_{ a}} $为第a只蚂蚁走过的路径平滑度。
4) 假设蚂蚁已经到达终点,则进入步骤5),否则返回步骤2)。
5) 对蚁群中蚂蚁搜索到的全部最优路径展开统计,将其按照取值大小排列,确定距离最短的路径,并以此为依据展开全局信息素更新[16-18]:
$$ \Delta {\tau _{ij}}\left( {t + 1} \right) = \frac{1}{{{l_{\mathrm{opt}}}}} \left( {1 - \rho } \right){\tau _{ij}}\left( {t + 1} \right) $$ (9) 式中:$ \Delta {\tau _{ij}}\left( {t + 1} \right) $为$ t + 1 $时刻信息素的变化量;$ {l_{\mathrm{opt}}} $为完成本次迭代后得到的最优路径长度。
6) 如果达到设定的迭代次数,则终止操作,同时输出模型的最优解[19-21],即最优路径动态规划方案,否则返回步骤2)。
2. 实验分析
2.1 实验设置
选取某煤矿作为研究对象,设置蚂蚁数量为10只,信息素挥发率为0.2,信息素增强因子为1,启发式因子为2,探索因子为0.1。为模拟煤矿井下复杂多变的环境,设置煤矿巷道相关参数,见表1。
表 1 煤矿巷道相关参数Table 1. Relevant parameters of coal mine roadway巷道类型 巷道风速/(m·s−1) 巷道坡度/(°) 巷道水位/m 回风联络巷 15~20 60~90 0~0.5 进风巷 15~20 0 0~0.3 轨道大巷 0~5 90 0~0.5 胶带大巷 0~5 0~30 0~0.3 回风巷 10~15 0~90 0~0.5 采区联络巷 10~15 30~60 0~0.5 对于任意一条巷道,包含上下行2个方向。在上行方向,行走难度随坡度增加而增加;在下行方向,坡度低于30°时,行走难度随坡度增加而下降,坡度不小于30°时,行走难度随坡度增加而增加。
为便于分析,将煤矿巷道分布简化,如图1所示,其中包含5个动态障碍物,分别标注为①−⑤,可以模拟井下可能出现的突发情况,如设备故障、人员移动等。动态障碍物的位置和状态可以随时间变化,从而增加路径规划的难度和复杂性。
2.2 评价指标
选取规划效果、路径长度及避障率作为评价指标。① 规划效果:从起点到安全出口的最佳路线,需要综合考虑路径复杂度、转弯次数等因素。② 路径长度:从起点到安全出口的规划逃生路径的长度。③ 避障率:在规划的逃生路径上成功避开的障碍物数量与总障碍物数量的比值。
2.3 结果分析
分别采用Dijkstra−ACO混合算法、A*算法[3]和改进ACO算法[4]对煤矿井下应急逃生路径进行动态规划,结果如图2所示。可看出利用A*算法和改进ACO算法规划出的煤矿井下应急逃生路径比较复杂,转弯次数较多,不利于煤矿井下工作人员的应急逃生,而Dijkstra−ACO混合算法规划出的煤矿井下应急逃生路径简单且平滑。
在50 m×100 m,100 m×200 m和150 m×250 m 3种不同尺寸的目标区域内,计算不同方法规划的逃生路径长度,结果见表2。可看出在不同尺寸的测试区域中,Dijkstra−ACO混合算法在路径长度上优于A*算法和改进ACO算法。在50 m×100 m区域,Dijkstra−ACO混合算法规划的路径长度为125 m,分别低于A*算法和改进ACO算法29,52 m;在100 m×200 m区域,Dijkstra−ACO混合算法规划的路径长度为157 m,分别低于A*算法和改进ACO算法32,53 m;在150 m×250 m区域,Dijkstra−ACO混合算法规划的路径长度为176 m,分别低于A*算法和改进ACO算法29,58 m。
表 2 不同方法规划的路径长度Table 2. Path lengths of different methods测试区域尺寸/(m×m) 路径动态规划方法 路径长度/m 50×100 Dijkstra−ACO混合算法 125 A*算法 154 改进ACO算法 177 100×200 Dijkstra−ACO混合算法 157 A*算法 189 改进ACO算法 210 150×250 Dijkstra−ACO混合算法 176 A*算法 205 改进ACO算法 234 不同方法的避障率结果如图3所示。可看出Dijkstra−ACO混合算法的避障率保持在98%左右,高于A*算法和改进ACO算法。
3. 结论
1) 将煤矿井下实体抽象为网络元素,基于巷道坡度和水位对逃生的影响分析,以网络边动态综合权重之和最小为目标函数,建立了煤矿井下应急逃生最优路径动态规划模型,以求取适应环境变化、逃生难度最低的最优路径。
2) 将Dijkstra算法和ACO算法结合,以求解煤矿井下应急逃生最优路径动态规划模型。利用Dijkstra算法快速确定初始路径,利用ACO算法寻找距离最短且安全性最高的逃生路径,兼顾了全局搜索和局部搜索。
3) 搭建模拟煤矿井下巷道、坡度、水位等实际情况的仿真环境,开展了应急逃生路径动态规划实验。实验结果表明,相较于基于A*算法和改进ACO算法的路径规划方法,基于Dijkstra−ACO混合算法的煤矿井下应急逃生动态规划方法得到的路径长度缩短了19%以上,且路径更加平滑、转弯更少,同时避障率提高了5%以上。
计量
- 文章访问数: 52
- HTML全文浏览量: 13
- PDF下载量: 14